//Multiply two 3x3 matrix (mat = a * b)
void Matrix_Multiply(float a[3][3], float b[3][3], float mat[3][3])
{
  float op[3]; 

  for(int i=0; i<3; i++)
  {
    for(int j=0; j<3; j++)
    { 
      for(int k=0; k<3; k++)
      {
        op[k] = a[i][k] * b[k][j];
      } 
      mat[i][j] = op[0] + op[1] + op[2];
    }
  }
}

//Add two 3x3 matrix (mat = a + b)
void Matrix_Add(float a[3][3], float b[3][3], float mat[3][3])
{
  for(int i=0; i<3; i++)
  {
    for(int j=0; j<3; j++)
    { 
      mat[i][j] = a[i][j] + b[i][j];
    }
  }
}


//Multiply and add two 3x3 matrix (mat = mat + a * b)
void Matrix_Multiply_Add(float a[3][3], float b[3][3], float mat[3][3])
{
  float op[3]; 

  for(int i=0; i<3; i++)
  {
    for(int j=0; j<3; j++)
    { 
      for(int k=0; k<3; k++)
      {
        op[k] = a[i][k] * b[k][j];
      } 
      mat[i][j] += op[0] + op[1] + op[2];
    }
  }
}
